/**
 * @file PostionStuckMonitor.h
 * @author  
 * @brief 位置卡死检测
 * @version 1.0
 * @date 2021-04-01
 * 
 * @copyright Copyright (c) 2021
 * 
 */

#pragma once

namespace  behavior_controller
{
    class PostionStuckMonitor
    {
    private:
        /* data */
        double pub_speed_linear_x;
        double pub_speed_angle_z;
    public:
        PostionStuckMonitor(/* args */){};
        ~PostionStuckMonitor(){};
        void run();
        void SetPubSpeed(double linear_x, double angle_z){pub_speed_linear_x=linear_x;pub_speed_angle_z=angle_z; };
        double speed_linear_x() {return pub_speed_linear_x;};
        double speed_angle_z() {return pub_speed_angle_z;};
        
    };
    //static 
    extern PostionStuckMonitor postion_stuck_monitor;

}